/*
 * To change this template, choose Tools | Templates
 * and open the template in the editor.
 */

package Behaviors.Schemas.Motor;

import Behaviors.Schemas.*;
import Robot.*;
import Util.*;
/**
 *
 * @author alejo
 */
public class MSGoForward extends Schema implements Vector2dSchema {

    private Position2d myPos;

    public MSGoForward(String name, Position2d myPos)
    {
        super(name);
        this.myPos = myPos;
    }

    public Vector2d Value()
    {
        Pose2d pos = myPos.read(Position2d.READ_MODE_NO_WAIT);

        return new Vector2d(1,pos.getPa(),Vector2d.MODE_MA);

    }
}
